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ABSTRACT 

The  primary  objective  of  this  paper  is  to  develop 
an  adaptive  bilateral  impedance  control  method  for 
a  team  of  mobile  robotic  agents,  which  implements 
formation  control,  cooperative  grasping  force  compen¬ 
sation,  and  operator  induced  error  compensation  for 
unconstrained,  constrained,  and  transition  motions. 
In  this  approach,  a  leader  robot  is  selected  and  tele- 
operated  by  an  operator  and  the  follower  robots  are 
autonomously  coordinated  to  make  a  formation  to 
perform  a  task  of  cooperatively  transferring  an  ob¬ 
ject.  By  estimating  the  target  dynamics,  the  bilateral 
impedances  of  the  system  are  adjusted  to  assist  the  op¬ 
erator  in  determining  grasping  forces  to  have  a  secure 
grip  of  the  object.  In  addition,  the  formation  can  be  re¬ 
configured  to  avoid  collisions  with  stationary  obstacles 
and  among  the  member  robots.  The  performance  of 
the  developed  method  was  investigated  through  haptic 
simulations.  In  the  simulation  study,  a  haptic  device 
was  used  as  the  master  robot,  and  three  virtual  omni¬ 
directional  mobile  platforms  were  employed  to  transfer 
an  object.  The  simulation  results  demonstrate  stable 
grasping  motions  of  the  team  of  the  mobile  robot  and 
position  and  force  errors  minimized  by  adapting  the 
bilateral  impedances  of  the  system. 

1  INTRODUCTION 

Over  the  past  decades,  several  noticeable  results 
have  been  reported  more  in  Single-Master- Single- 
Slave  (SMSS)  than  multiple  slave  robot  teleoperation 
to  handle  some  simple  tasks.  Similarly,  the  SMSS 
and  the  multiple  slave  robot  teleoperation  also  pre¬ 
vent  a  human  operator  from  directly  getting  into 
hazardous  or  inaccessible  environment.  However, 
some  applications,  such  as  the  plant  maintenance, 
construction,  and  surgery,  require  many  slave  robots 
to  simultaneously  work  in  a  remote  area.  In  addition, 
only  the  multiple  slave  robotic  teleoperation  can 
amplify  human  effort.  Therefore,  the  Single-Master 
Multi-Slave  (SMMS)  teleoperation  is  studied  in  this 
paper. 


In  the  SMMS,  because  the  number  of  the 
slave  degrees  of  freedom  is  more  than  that  of  the 
master  degrees  of  freedom,  it  is  not  feasible  the 
system  is  manually  controlled.  Nevertheless,  a  fully 
automatic  control  is  not  also  possible  when  many 
complex  tasks  require  human  flexible  intelligence. 
Therefore,  a  combination  of  human  and  machine 
controls  is  necessary.  Generally,  most  of  the  SMMS 
applications  require  robots  to  handle  a  bulky  object 
cooperatively.  The  tasks,  such  as  manipulating  a 
large  object  with  a  team  of  robots  and  etc,  demand 
all  accurate  and  closely  coordinated  actions  of  team 
members.  In  [3,  4],  Lee  and  Spong  et  al  developed 
a  cooperative  multiple  slave  robot  teleoperator  to 
transport  an  object  by  autonomously  controlling  a 
decoupled  grasping  shape.  Nonetheless,  an  obstacle 
avoidance  task,  a  well  known  issue,  in  the  object 
transportation  heavily  relies  on  human  performance 
in  the  reported  work.  The  performance  is  limited 
by  the  operators  motor  skills  and  his  ability  to 
maintain  situational  awareness  [10].  As  a  result  of 
the  bad  performance,  a  human  error,  i.e.  a  human 
command  that  causes  robots  and/or  environments  to 
be  damaged,  is  easily  made.  Besides,  the  grasping 
stability  of  the  transported  object,  i.e.  pressure 
exerted  by  each  robot  on  the  object  is  stable  enough 
to  hold  it  firmly,  is  necessary  [2,  6].  In  the  SMMS, 
the  different  pressures  acting  on  different  transported 
object  materials  are  required  to  be  online  determined 
by  an  operator  or  robot.  However,  in  most  of  the 
research,  [1,  2,  6,  10,  9],  their  proposed  systems  do  not 
allow  the  operator  or  robot  to  adjust  the  pressures 
based  on  their  own  judgments  on  the  object  material. 

Therefore,  the  primary  objective  of  this  pa¬ 
per  is  to  develop  an  adaptive  bilateral  impedance 
control  method  that  combines  formation  control, 
grasping  force  compensation,  and  human  error  recov¬ 
ery.  During  the  operation,  the  operator  only  focuses 
on  controlling  the  leader  robot  and  the  follower  robots 
autonomously  cooperate  to  make  a  formation  with 
the  leader  based  on  environmental  information.  The 
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adaptive  formation  and  recovery  functions  are  used  to 
adapt  the  formation  and  correct  erroneous  or  drastic 
operatior  commands  to  modify  the  path  for  the  leader 
robot.  By  estimating  the  dynamics  of  a  target  [1,  2], 
the  teleoperator  impedances  are  adapted  to  assist  the 
operator  in  determining  a  grasping  force,  i.e.  the  force 
required  to  secure  a  grasp  of  the  object.  The  force 
compensators  modify  their  compliances  to  damp  out 
oscillatory  contact  with  the  object  [5,  9]. 

Typical  SMMS  teleoperation  systems  are  re¬ 
viewed  and  an  adaptive  bilateral  control  method  is 
developed,  which  can  relieve  an  operators  burden  of 
teleoperating  a  team  of  robots  in  complex  environment 
for  an  extended  period  of  time.  The  performance 
of  the  proposed  system  in  terms  of  stability  and 
transparency  is  verified  through  haptic  simulations. 

2  SMMS  TELEOPERATION 


(a)  Master  Robot 


Master  positions  and 
forces 


Slave  team  positions 
and  forces 


(b)  Slave  Robot  Team 


Figure  1:  SMMS  teleoperation  system 


where  for  i—  l,..n,  xspi  and  xsl  are  the  ith  slave 
followers  and  leaders  positions,  respectively.  xm  and 
xst  are  the  n  x  1  generalized  coordinate  vectors 
representing  positions  and  orientations  of  the  master 
robot  and  the  slave  team  or  the  transported  object 
in  their  working  coordinate  systems,  respectively. 
xm,  xst ,  xm,  and  xst  are  derivatives  of  xm,  %,xm,  and 
xst,  respectively.  feFi  and  feL  are  the  n  x  1  vectors 
representing  the  ilh  slave  followers  and  leaders  sensed 
force,  respectively.  fet  is  the  n  x  1  vector  representing 
an  averaging  sum  of  environmental  force  sensed  by 
remote  sensors  on  the  slave  robots,  Mm  and  Ms  are 
the  n  x  n  inertia  matrices  of  the  master  and  each 
slave,  respectively.  Bm  and  Bs  are  the  n  xn  vectors  of 
the  viscous  coefficients  of  the  master  and  slave  team 
robots,  respectively.  /?  ^  0  is  the  force  amplification 
between  the  robots,  fh  is  the  n  x  1  vector  of  the 
operational  forces  applied  to  the  human  operator  by 
the  master  manipulator.  Km ,  Ks ,  C2,  and  C3  are  the 
controller  parameters  for  the  bilateral  teleoperator. 
The  formation  center  is  computed  by  using  Eqs.  (3) 
and  (4)  as  the  location  of  the  team  of  robots.  The 
transported  object  is  assumed  to  be  constrained  to 
the  center  of  the  formation  when  it  is  being  carried. 

The  transparency  of  the  system  can  be  mea¬ 
sured  [3,  4]  by  such  a  way  that  fh  =  fet  and  xm  =  xst 
are  achieved.  It  is  noted  that  the  perfect  trans¬ 
parency  is  not  realistic  because  of  significant  time 
delays  such  as  control  latency,  system  processing 
time,  communication  delay,  etc.  A  variety  of  robot 


Figure  1  (a)  and  (b)  show  the  master  and  slave 
robots  of  a  typical  bilateral  teleoperator.  In  general, 
the  linearized  dynamic  equations  of  the  system  are  ex¬ 
pressed  as 
Master: 


A4m(xm  xsi )  T  xsi )  T  ATm(xm  xsi ) 

=  C2^fet~fh  (1) 


Slave  Robotic  Team: 


Ms(xst  tbm)  T  Bs(xst  %m)  T 

=  C3fh  -  |  fet  (2) 


n 

XsFi  +  %sL 

i= 0 


n  +  1 


—  %st 


n 

feFi  +  feL 

i= 0 

71+1 


fet 


(3) 

(4) 


(a)  Center  Reference  (b)  Leader  Reference 


(c)  Neighbor  Reference 


Figure  2:  Formations 

formations  is  pursued  due  to  the  consideration  of 
different  tasks,  environments,  and/or  sensor  con¬ 
straints.  Balch  and  Arkin  et.  al.  proposed  three 
different  techniques  for  determining  a  formation[l], 
such  as  the  center  referenced,  neighbor-reference, 
and  leader-referenced  formations  as  shown  in  Figure 
2.  The  leader-referenced  formation  is  most  suitable 
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for  SMMS  because  the  other  methods  require  more 
computational  resources  [1]. 

3  ADAPTIVE  BILATERAL  CONTROL 

Commanded  Positions  and  Velocities 
Master  Positions  and  Forces 


Figure  3:  Bilateral  SMMS  teleoperator 


The  overall  architecture  of  the  proposed  system 
is  schematically  described  in  Figure  3.  The  master 
and  slave  systems  are  connected  over  wired  or  wireless 
internet. 

Each  subsystem  of  the  bilateral  SMMS  teleopera¬ 
tion  system  is  presented  in  Figure  4.  The  equations  of 
motion  of  the  systems  can  be  rewritten  as 
Master: 

Mrn'ern  +  5mem  T  Krnern  =  ffh  feF  (5) 
Slave  Leader: 

MsLesL  +  MsL(3ieSL  +  MsL(30eSL  =  vTsLaSL 

+(1  -W)(Ce6FeL  +  U0)  (6) 

Slave  Follower: 

MSFi'eSFi  +  MsFiP\eSFi  +  MsFifloeSFi  —  vJFi^sFi 

+Uf  +  (l-W)(Ce5FeFi  +  U0)  (7) 

where  and  fh  are  defined  previously.  For 

i  =  1 ,  ...n,  Msl  and  Msfi  are  the  nxn  inertia  matrices 
of  the  leader  and  ith  follower,  respectively.  em,  eSL, 
&sFi,  em,  eSL ,  and  esFi  are  the  derivatives  of  em,  esF , 
eSFi,  em,esL,  and  esFi ,  respectively.  em  =  xm  -  x'sL, 

esL  =  %SL  and  CsFi  =  %sFi  %sFdi'  %sFi  1® 

the  measured  ith  slave  follower’s  position.  xspdi  is 
the  desired  position  of  the  ith  follower  with  respect  to 
the  leader’s  position.  xm  is  the  position  of  the  leader. 
x fm  and  x'sL  are  the  delayed  transmitted  masters  and 
leaders  positions,  respectively.  f3\  and  /3q  are  the 
positive  constants  chosen  such  that  s2  +  flis  +  (3$ 
is  a  stable  (Hurwitz)  polynomial.  Bm  is  the  master 
adaptive  impedance  gain  which  is  regulated  based  on 


Master  Robot  Positions  and 
Forces 

Leadership  and  Target  i 


Slave  Leader  Positions 
and  Forces 

Leadership  and  Target 
Selections 

(a)  Master  robot 

Master  Positions  and  Forces 
Leadership  and  Target  Selections 


(b)  Slave  leader  or  follower 


Figure  4:  Architecture  of  the  developed  SMMS  system 


an  estimate  of  the  environment.  vsl  =  [zsl  %sl  %sl]T • 
xsL  is  the  derivative  of  xsL.  zsL  =  x'^  -  f3iesL  -  (30esL 
where  x fm  is  the  delayed  transmitted  acceleration. 
aSL  =}WMsL  -  MsL  WBsL  -  BsL  WKsL  -  KsL]t. 

and  Ksl  are  the  adaptive  control  gains  for 
the  leader.  Bsl  and  Ksl  are  the  n  x  1  vectors  that  rep¬ 
resent  the  viscosity  of  the  dynamics  of  the  leader  and 
controller  parameters,  respectively.  SFcl  =  fedh~  feL- 
feL  is  the  forcing  function  for  the  leader.  fedh  is  the 
operators  input  force  and  W  is  the  switching  gain.  Ce 
is  the  force  compensator  gain  and  UQ  is  the  obstacle 
avoidance  gain.  vsfi  =  [ zsfi  xSFi  xSFi]T •  xSFi  is  the 
derivative  of  xsFi  •  zsFi  =  x'sFdi  -  fi\esFi  -  A) ^sff 
x'sFdi  is  the  delayed  transmitted  acceleration.  aSFi  = 

[WMsFi  -  MsFi  WBsFi  -  BsFi  WKsFi  -  KsFl]T 

.  MSFi ,  BSFi,  and  KSFi  are  the  ith  followers  adap¬ 
tive  control  gains.  BsFi  and  KsFi  are  the  n  x  1 


Selection 

Slave  Leader  Positions  and 
Forces 
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vectors  that  represent  the  damping  coefficients  of 
the  dyanmics  of  and  control  parameters  for  the  ith 
follower  ,  respectively.  SFeFi  =  fedi  -  feFi.  feFi  and 
fedi  are  the  actual  and  desired  contact  force  on  each 
follower,  respectively.  Uf  is  the  formation  control  gain. 

In  Figure  4,  the  obstacle  avoidance  UQ  and 
adaptive  formation  control  Uf  functions  in  Eqs.(5)- 
(7),  are  written  as  respectively 

TT  \ 4*  (  be5Vi)  if  5x0  <  77 min,  ,  . 

Uo~  lo  USx  >  r-  (  ) 

Uf  kffrsmin  $%sFi)  (9) 

where  SV\  —  1  —  —x,  5D\  —  v imin  SxQ  ,  v 

1  xmzn 

and  rsrnin  are  the  minimum  distances  that  a  robot 
needs  to  keep  away  from  obstacles,  e.g.  the  other 
robots  and  acutal  obstacles,  x  is  the  position  vector  of 
each  slave  robot  or  follower  robot.  SxQ  is  the  distance 
between  the  robot  and  obstacles.  SxsFi  is  the  distance 
between  a  robot  and  the  leader.  cj>  is  the  auto- selected 
parameters.  fce,fc/,  and  be  are  the  two  stiffness  and 
damping  coefficients,  respectively.  Eqs.(8)  and  (9) 
enable  a  robot  to  automatically  prevent  collisions 
with  obstacles  and  other  team  robots.  The  values 
of  U0  and  Uf  are  computed  to  regulate  slave  robot 
paths  based  on  sensed  various  robot-leader  and 
robot-obstacle  distances.  Since  the  robot  team  keeps 
moving  in  a  formation,  the  equations  enable  a  robot 
to  maintain  a  distance  from  the  leader.  However,  its 
position  relative  to  the  leader  can  change.  Therefore, 
the  formation  is  changed,  ensuring  that  all  followers 
closely  track  the  leader. 

The  local  force  compensator  and  sensor  based 
auto- switching  function  are  written  respectively  as 

Ce  =  7[1  -  exp(-a\5Fe\)\  (10) 

W  =  'ywexp(—p\SFe\  -  <p\rimax  -  5xsFi |)  (11) 

where  SFe  is  the  difference  of  the  actual  and  desired 
contact  forces  for  the  leader  and  a  follower  or  two 
followers.  a,  ip,  p,  and  7  are  the  positive  constants. 
7^  is  the  positive  sensitivity  constant,  1  >  7^  >  0. 
A  Bezier  approximation,  Eqs.(10)&(ll)  are  used  to 
provide  a  smooth  transition  between  manual  and 
autonomous  control  inputs. 

The  good  transparency  is  only  maintained 
when  the  forces  do  not  differ  from  the  reference 
forces  prescribed  by  the  operator.  The  local  force 
compensator  is  used  to  accommodate  the  excessive 
force  by  changing  their  paths.  The  described  local 
intelligences  in  the  system  are  used  to  keep  a  condi¬ 


tional  transparency  and  stable  grasp  of  the  object  if 
the  object  is  transported. 

4  HAPTIC  SIMULATIONS 

Table  1:  Descriptions  of  the  different  control  methods 
in  the  SMMS  simulations 


Sim 

Control 

Method 

Dynamic 

Equation 

Formation 

Method 

1 

Impedance 

Control 

Eqs.(l)-(4) 

Fixed 

2 

Adaptive 

Impedance 

Eqs.(5)-(11) 

Adaptive 

Two  haptic  simulations,  Sim  1  and  Sim  2  with 
two  different  control  methods  as  described  in  Table 
1  were  performed  to  quantify  system  performance  in 
the  presence  of  a  constant  communication  delay,  all  of 
which  involved  a  human  operator  in  a  control  loop. 


(a)  Master  Robot 


Slave  Positions  and  Forces 


Leader 

Transported 

Object 

Follower! 

Folio  wer2 

Leader  and  Target  Selections  O3)  Slave  Robots 


Figure  5:  Haptic  simulation  of  a  SMMS  semi- 
autonomous  teleoperation  system 


As  shown  in  Figure  5  (a)  and  (b),  Phantom, 
a  6-DOF  haptic  device  was  used  as  the  master 
system  and  virtual  robots  as  the  team  of  slave 
robots.  The  team  as  shown  in  Figures  1  (b)  and  5 
(b)  has  a  workspace  approximately  100  times  the 
master  robots.  This  configuration  is  representative 
of  an  actual  teleoperation  system  used  for  industrial 
applications  [9]. 

The  virtual  team  consists  of  three  omni¬ 
directional  mobile  robots  programmed  in  Visual  C++ 
OpenGL  [5,  9,  11]  without  a  gripper.  Therefore, 
the  three  robots  can  only  push  an  object  against 
each  other  to  transport  it  from  one  place  to  another. 
Impedance  control  has  been  the  main  approach  to 
many  applications  of  teleoperation  such  as  material 
transportation  and  obstacle  avoidance  [8,  12].  In  order 
to  simplify  and  highlight  the  problems,  a  well-defined 
task  was  used  in  the  simulation  study,  the  objectives 
of  which  include  obstacle  avoidance,  human  command 
error  recovery,  and  robust  transportation  of  an  object 
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Leader 

Transported 

Object 

Followed 

Followerl 

(a)  Transporting 


Leader 

Transported 

Object 

Followerl 

Followed 

(c)  Arriving 


Figure  6:  Simulated  tasks 


subject  to  a  constant  communication  delay  of  0.1 
seconds.  The  communication  delay  was  chosen  in  the 
simulations  because  there  is  a  critical  value,  beyond 
which  the  system  will  tend  to  become  unstable  [7]. 
The  desired  distance  between  two  robots  was  set  to 
5m.  The  minimum  distance  between  a  robot  and  an 
obstacle  was  set  to  5m.  Six  static  circular  objects 
with  the  radii  of  15m  were  used  in  each  simulation. 

The  objectives  of  the  task  of  transporting 
an  object  is  to  make  stable  contacts  with  the  object 
and  avoid  any  obstacles.  The  omnidirectional  movable 
slave  robots  with  three  wheels  tightly  touching  the 
ground  were  simulated.  Only  two  directions  parallel 
to  the  ground  were  considered  in  the  simulations.  The 
master  and  slave  forces  and  positions  were  measured 
through  the  haptic  device  and  divided  by  10,  respec¬ 
tively.  The  team  robots  with  carrying  the  object  were 
moved  from  the  origin  to  the  final  destination  by 
passing  through  the  area  full  of  obstacles  in  Figure  6. 
In  the  simulations,  the  following  parameters  were  used: 

Mm  =  3  kg,  Km  =  6  Ns/m,  MsL  =  30  kg,  BsL 


=  1.0  Ns/m,  KsL  =  60  N/m,  MsFi  =  30  kg,  BsFi  = 
1.0  Ns/m,  KsFi  =  60  N/m,  ke  =  100,  be  =  60,  rimin 
:  5,  V Smin  =  5,  kf  =  1,  OL  =  p  =  1,  (3\  =  10000,  /3q  = 
500,  and  <p  =  7  =  =1 

In  the  simulation,  no  friction,  gravity,  and 
air  resistance  were  assumed  in  the  environment.  If 
the  contact  forces  in  any  direction  exceeds  0.7  N, 
the  object  and  robots  were  assumed  to  be  damaged. 
The  slip  was  programmed  to  occur  between  the  robot 
and  the  object  only  if  the  static  friction  condition 
[18]  was  not  met,  i.e.  the  pushing  force  larger  than 
the  maximum  allowable  static  friction  force  where 
the  friction  coefficient  was  assumed  to  be  0.5.  In 
the  simulation,  the  slave  forces  are  fet.  The  position 
errors  are  em,  esF ,  and  esFi.  The  force  errors  are 
SFeFi  and  SFeL. 


4.1  Obstacle  Avoidance  and  Contact  Stability 


Sim  2  was  run  with  adaptive  formation  and  force 
compensation  as  opposed  to  Sim  1.  As  depicted  in  Fig¬ 
ures  17-20,  the  force  compensator  kept  stable  contacts 
with  the  transported  object  while  the  tracking  perfor¬ 
mance  was  compromised  for  obstacle  avoidance.  The 
followers  autonomously  rotated  the  object  about  the 
axis  normal  to  the  ground  as  shown  in  Figures  14-20  to 
avoid  the  obstacles  while  satisfying  the  following  three 
conditions:  (1)  The  distance  between  any  two  robots 
was  unchanged.  (2)  The  distances  between  robots  and 
obstacles  were  always  larger  than  the  required  safety 
distance.  (3)  The  object  was  grasped  firmly.  Nonethe¬ 
less,  as  shown  in  Figures  7-13,  the  operator  was  able 
to  pass  through  the  area  full  of  obstacles  without  col¬ 
lision. 


4.2  Human  Command  Error  Recovery  and 
Transparency 


In  Sim  2,  it  is  noted  that  the  human  operator  did 
not  necessarily  give  accurate  commands  to  the  team  to 
avoid  the  obstacles.  Each  robot  has  its  own  capability 
to  choose  whether  to  compromise  or  enhance  tracking 
performance  between  the  master  and  itself.  As  seen  in 
Figures  17-20,  the  tracking  performance  was  sacrificed 
due  to  human  errors  during  the  time  period  of  225  -280 
seconds  but  improved  before  225  seconds  and  after  280 
seconds.  Except  the  stated  time  period,  the  position 
errors  as  shown  in  Figures  17  and  18  were  smaller  than 
those  in  Figures  10  and  11. 
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Figure  7:  Sim  1  -  Actual  paths 


Figure  11:  Sim  1  -  Position  errors  in  the  y-direction 
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Figure  8:  Sim  1  -  Grasping  forces  in  the  x-Direction 


Figure  12:  Sim  1  -  Force  errors  in  the  x-direction 
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Figure  9:  Sim  1  -  Grasping  forces  in  the  y-direction 


Figure  13:  Sim  1  -  Force  errors  in  the  y-direction 
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Figure  10:  Sim  1  -  Position  errors  in  the  x-direction 


Figure  14:  Sim  2  -  Actual  paths 
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Figure  15:  Sim  2  -  Grasping  forces  in  the  x-direction 


Figure  16:  Sim  2  -  Grasping  forces  in  the  y-direction 

CONCLUSIONS 

The  primary  objective  of  this  paper  was  to  de¬ 
velop  an  adaptive  bilateral  impedance  control  method 
for  a  team  of  mobile  robotic  agents,  which  implements 
formation  control,  cooperative  grasping  force  compen¬ 
sation,  and  operator  induced  error  compensation  for 
unconstrained,  constrained,  and  transition  motions. 
In  this  approach,  a  leader  robot  is  selected  and  tele- 
operated  by  an  operator  and  the  follower  robots  are 
autonomously  coordinated  to  make  a  formation  to 
perform  a  task  of  cooperatively  transferring  an  ob¬ 
ject.  By  estimating  the  target  dynamics,  the  bilateral 
impedances  of  the  system  are  adjusted  to  assist  the  op¬ 
erator  in  determining  grasping  forces  to  have  a  secure 
grip  of  the  object.  In  addition,  the  formation  can  be  re¬ 
configured  to  avoid  collisions  with  stationary  obstacles 
and  among  the  member  robots.  The  performance  of 
the  developed  method  was  investigated  through  haptic 
simulations.  In  the  simulation  study,  a  haptic  device 
was  used  as  the  master  robot,  and  three  virtual  omni¬ 
directional  mobile  platforms  were  employed  to  transfer 
an  object.  The  simulation  results  demonstrate  stable 
grasping  motions  of  the  team  of  the  mobile  robots  and 
position  and  force  errors  minimized  by  adapting  the 
bilateral  impedances  of  the  system.  The  human  com¬ 


Time  (seconds) 


Figure  17:  Sim  2  -  Position  errors  in  the  x-direction 
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Figure  18:  Sim  2  -  Position  errors  in  the  y-direction 


mand  error  recovery  and  force  compensation  does  not 
modify  the  existing  designs  of  industrial  robots,  such 
as  mounting  a  passive  compliant  device  on  the  tip. 
The  performance  in  terms  of  transportation  efficiency 
and  grasp  stability,  of  the  develped  method  was  vali¬ 
dated  throug  haptic  simulations  subject  to  a  constant 
delay.  With  the  developed  method,  stable  grasping 
was  obtained  through  modification  of  the  commanded 
trajectory,  and  the  position  and  force  errors  were  min¬ 
imized  by  adapting  the  master-slave  impedance. 
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Figure  19:  Sim  2  -  Force  errors  in  the  x-direction 
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Figure  20:  Sim  2  -  Force  errors  in  the  y-direction 
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